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Here are some easy to use 16- and 32-bit math routines 
that take the pain out of calculations such as PID 
loops, A/D calibration, linearization calculations and 
anything else that requires 32-bit accuracy. 

The package is written to interface with PL/M-51. Pa- 
rameters are passed as 16-bit words to the routines, 
which perform operations on a 32-bit "accumulator" 
resident in memory. The following functions are per- 
formed: 

Load_16 (word_param) 

Loads a 16-bit -RD into the low half of the 32-bit "ac- 
cumulator", zeros upper 16 bits of accumulator. 

Load_32 (word_hi,word_lo) 

Loads word_hi into upper 16 bits of accumulator, word 
lo_into Lower 16 bits. 

Low_16 

Returns the lower 16 bits of the accumulator, bits 
through 15. 

Mid_16 

Returns the middle 16 bits of the accumulator, bits 8 
through 23. 

High_16 

Returns the upper 16 bits of the accumulator, bits 16 
through 31. 

Mul_16 (word_param) 

Multiplies the 32-bit accumulator by the 16-bit word 
supplied, result left in accumulator. 

Div_16 (word_param) 

Divides the 32-bit accumulator by the 16-bit word sup- 
plied, result left in accumulator. 

Add_16 (word_param) 

Adds the 16-bit word supplied to the 32-bit accumula- 
tor. 



Sub_16 (word_param) 

Similar to Add_16 but for subtraction. 

Add_32 (word_hi,word_lo) 

Forms a 32-bit value for word_hi and word_lo and 
adds it to the accumulator. 

Sub_32 (word_hi,word_lo) 

Similar to Add_32 but for subtraction. 



APPLICATION 

Typical applications have 16-bit "input" values and 
produce 16-bit "output" values, but require 32-bit val- 
ues for intermediate results. An example would be 
reading a 12-bit A/D, performing some gain and offset 
calculation on the raw A/D data to produce a calibrat- 
ed 16 bit result. Doing this is a simple task with this 
math package. 

CALL Load_16(AD_value) ; 

CALL Add_16 (of f set_value) ; 

CALL Mul_16 (gain_factor) ; 

/• gain is in units of 1/256 */ 

result = Mid_16 ; 

In this example the accumulator was loaded with the 
raw A/D value and then the offset was applied. The 
gain_factor was "pre-multiplied" by 256 (8 bits), giving 
it a granularity of 1/256. The result was extracted from 
the "middle" 16 bits of the accumulator (bits 8 to 23) to 
account for the scaling factor of 256 introduced in the 
multiply step. 

The package requires about 384 bytes of ROM and 30 
bytes of RAM. Individual routines can be deleted to 
conserve RAM if they are not used. 
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NAME Math_32_Module 




PUBLIC Load 


16, 


?Load 16?byte 




PUBLIC Load 


~32, 


?Load 32?byte 




PUBLIC Mul 


16, 


?Mul 16?byte 




PUBLIC Div" 


16, 


?Div 16?byte 




PUBLIC Add 


16, 


?Add 16?byte 




PUBLIC Sub" 


16, 


?Sub 16?byte 




PUBLIC Add - 


32, 


?Add 32?byte 




PUBLIC Sub" 


32, 


?Sub 32?byte 




PUBLIC Low_ 


16, 


1id_16, High_16 




Math 32 Data 


SB 


31ENT DATA 




Math_32_Code 


SB 


3MENT CODE 




RSEG Math 32 Data 




?Load_16?byte: 


DS 


2 




?Load 32?byte: 


DS 


4 




?Mul 16?byte: 


DS 


2 




?Div 16?byte: 


DS 


2 




?Add 16?byte: 


DS 


2 




?Sub 16?byte: 


DS 


2 




?Add 32?byte: 


DS 


4 




?Sub 32?byte: 


DS 


4 




OP 0: 


DS 


1 




op is 


DS 


1 




OP 2: 


DS 


1 




OP 3: 


DS 


1 




TMP 0: 


DS 


1 




IMP 1: 


DS 


1 




IMP 2: 


DS 


1 




IMP 3: 


DS 


1 




RSEG Math 32 Code 
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Load 1.6 ' 






■ Load 






aew 


OP 3,10 




WW 


OP_2,#0 




MOV 


\jc l f . Loau lo.Dyte 




MOV 


OP_0,?Load_i6?byte + 1 




RET 






Load_32: 






;Load 


all the OP registers with the value supplied 




MOV 


OP 3,?Load 32?byte 




MOV 


OP 2,?Load 32?byte + 1 




MOV 


OP l,?Load 32?byte + 2 




MOV 


OP 0,?Lcad 32?byte + 3 




RET 






Low 16: 






; Return the lower 16 bits of the OP registers 




MOV 


R6,OP 1 




MOV 


R7,OP_0 




RET 






Mid 16: 






; Return the middle 16 bits of the OP registers 




MOV 


R6,OP 2 




MOV 
RET 


R7,OP_l 




High 16: 






; Return the high 16 bits of the OP registers 




MOV 


R6,OP 3 




MOV 
RET 


R7,OP_2 




Add 16: 






;Add 


the 16 bits supplied by the caller to the OP registers 




CLR 


C 




MOV 


A, OP 




ADDC 


A,?Add 16?byte +1 ;low byte first 




MOV 


OP 0,A~ 




MOV 


A,OP_l 




ADDC 


A,?Add 16?byte ;high byte + carry 




MOV 


OP 1,A 




MOV 


A,OP_2 




ADDC 


A,#0 ; propagate carry only 




MOV 


OP 2, A 




MOV 


A,OP_3 




ADDC 


Af*0 ;propagate carry only 




MOV 


OP_3,A 




RET 
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Add 32: 








;Add the 32 bits supplied by the caller to the OP registers 




CLR 


c 






MOV 


A, OP 






ADDC 


A,?Add 32?byt= + 3 


; lowest byte first 




MOV 


OP 0,A 






MOV 


A, OP 1 






ADDC 


A,?Add 32?byte + 2 


;mid-lowest byte + carry 




MOV 


OP 1,A 






MOV 


A,OP 2 






ADDC 


A,?Add 32?byte + 1 


; mid-highest byte * carry 




MOV 


OP 2, A 






MOV 


A,OP 3 






ADDC 


A,?Add 32?byte 


; highest byte + carry 




MOV 


OP 3,A 






RET 








Sub 16: 








.•Subtract the 16 bits supplied by the caller from the OP registers 




CLR 


C 






MOV 


A,OP 






SUBB 


A,?Sub 16?byte + 1 


;low byte first 




MOV 


OP 0,A 






MOV 


A, OP 1 






SUBB 


A,?Sub 16?byte 


;high byte + carry 




MOV 


OP I, A 






MOV 


A,OP 2 






SUBB 


A,#0 


; propagate carry only 




MOV 


OP 2, A 






MOV 


A,OP 3 






SUBB 


A,#0 


; propagate carry only 




MOV 
RET 


OP 3, A 






Sub 32: 








,-Subtract the 32 bits supplied by the caller from the OP registers 




CLR 


C 






MOV 


A,OP 






SUBB 


A,?Sub 32?byte + 3 


.•lowest byte first 




MOV 


OP 0,A 




MOV 


A, OP 1 






SUBB 


A,?Sub 32?byte + 2 


;mid-lowest byte + carry 




MOV 


OP 1,A 






MOV 


A, OP 2 






SUBB 


A,?Sub 32?byte + 1 


; mid-highest byte + carry 




MOV 


OP 2, A 




MOV 


A,OP 3 






SUBB 


A,?Sub 12?bjze 


; highest byte + carry 




MOV 


OP_3,A 




RET 
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Mul 16: 








;Multiply the 32 bit OP with the 16 value supplied 




MDV 


IMP 3,#0 


;clear out upper 16 bits 




MOV 


1MP _ 2,#0 






;Generate the lowest 


Dyte of the result 




MOV 


B,OP 






MOV 


A,?Mul 16?byte+l 




MUL 


AB 






MOV 


IMP ,A 


; low-order result 




MOV 


IMP 1,B 


;high order result 




;Now generate the next higher order byte 




MOV 


B,OP 1 






MOV 


A,?Mul 16?byte+l 




MUL 


AB 






ADO 


A,1MP 1 


; low-order result 




MOV 


IMP 1,A 


; save 




MOV 


A,B 


; get high-order result 




ADDC 


A,IMP 2 


; include carry from previous operation 




MOV 


IMP 2,A 


; save 




JNC 


Mul loopl 






INC 


TOP_3 


; propagate carry into TOP 3 




Mill loool* 








~ MOV 


B,OP 






MOV 


A,?Mul 16?byte 






MUL 


AB 






ADD 


A, IMP 1 


; low-order result 




MOV 


IMP 1,A 


; save 




MOV 


A/B 


; get high-order result 




ADDC 


A, IMP 2 


; include carry from previous operation 




MOV 


TOP 2,A 


; save 




JNC 


Mul loop2 






INC 


TOP 3 


; propagate carry into TOP_3 




Mul loop2: 








; Now 


start working on the 3rd byte 




MOV 


B,OP 2 






MOV 


A,?Mul 16?byte+l 




MUL 


AB 






ADD 


A,IMP 2 


; low-order result 




MOV 


TOP 2,A 


; save 




MOV 


A,B 


; get high-order result 




ADDC 


A, IMP 3 


; include carry from previous operation 




MOV 


TOP 3,A 


; save 




; Now 


the other half 






MOV 


B,OP 1 






MOV 


A,?Mul 16?byte 






MUL 


AB 






ADD 


A,IMP 2 


; low-order result 




MOV 


IMP 2,A 


; save 




MOV 


A,B 


; get high-order result 




ADDC 


A, IMP 3 


; include carry from previous operation 




MOV 


TOP 3,A 


; save 




; Now finish off the highest order byte 




MOV 


B,OP 3 






MOV 


A,?Mul_16?byte+l 
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MUL AB 




ADD A, IMP 3 ; low-order result 




MOV TMP_3,A ; save 

; Forget about the high-order result, this is only 32 bit math! 






MOV B,OP 2 




MOV A,?Mul 16?byte 




MUL AB 




ADD A,TMP 3 ; low-order result 




MOV TOP_3,A ; save 




; Now we are all done, move the TOP values back into OP 




MOV OP 0,TMP 




MOV OP 1,TMP 1 




MOV OP 2,TWP 2 




MOV OP_3,TOP_3 




RET 
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Div 16: 






;This divides the 32 bit OP register by the value supplied 




MOV 


R7,#0 




MOV 


R6,»0 ; zero out partial remainder 




MOV 


TMP 0,#0 




MOV 


TMP 1,#0 




MOV 


TMP 2, tO 




MDV 


TMP 3,»0 




MOV 


Rl,?Div 16?byte ;load divisor 




MDV 


R0,?Div 16?byte+l 




MOV 


R5.I32 ;loop count 




;This begins the loop 




Div loop: 






CMX 


Shift_D ; shift the dividend and return MSB in C 




MOV 


A,R6 ; shift carry into LSB of partial remainder 




RLC 


A 




MOV 


R6,A 




MDV 


A,R7 




RLC 


A 




MDV 


R7,A 




;now test to see if R7:R6 >- R1:R0 




JC 


Can sub ;Carry out of R7 shift means R7:R6 > R1:R0 




CLR 


C 




MOV 


A,R7 ; subtract Rl from R7 to see if Rl < R7 




SUBB 


A,R1 ; A = R7 - Rl, carry set if R7 < Rl 




JC 


Cant sub 




;at this point R7>R1 or R7=R1 




JNZ 


Can sub ;jump if R7>R1 




;if R7 


= RL, test for R6>=R0 




CLR 


C 




MOV 


A,R6 




SUBB 


A,R0 ; A = R6 - RO, carry set if R6 < RO 




JC 


Cant_sub 




Can sub: 






; subtract the divisor from the partial remainder 




CLR 


C 




MOV 


A,R6 




SUBB 


A,R0 ; A = R6 - RO 




MDV 


R6,A 




MOV 
SUBB 


A,R7 

A,R1 ; A = R7 - Rl - Borrow 




MDV 


R7,A 




SETS 


C ; shift a 1 into the quotient 




JMP 


Quot 




Cant sub: 






; shift 


a into the quotient 




CLR 


C 




Quot: 






; shift 


the carry bit into the quotient 




CALL 


Shift_Q 




; Test 


for competicn 




DJNZ 


R5,Div loop 




; Now 


we are all done, move the TMP values back into OP 




MOV 


OP 0,TMP 




MOV 


0P_1 ,TMP_1 
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?TJV 






MDV 






RETT 






Shif t__D: 






;shif t 


che dividend one bit to the left and return the MSB in c 




CLR 


C 




MDV 


A, OP 




KLC 


A 




MDV 


OP_0,A 




MOV 


A, OP 1 




RLC 


A 




MDV 


OP_l,A 




MOV 


A, OP 2 




RLC 


A 




MOV 


OP_2,A 




MOV 


A,OP_3 




PLC 


A 




MOV 


OP_3,A 




RET 






Shift Q: 






; shift 


the quotent one bit to the left and shift the C into LSB 




tew 


A, TMP 




PLC 


A 




MOV 


TMP 0,A 




MOV 


A,TMP 1 




RLC 


A ~~ 




MOV 


TMP 1,A 




MDV 


A.TMP 2 




RLC 


A 




MOV 


TMP 2,A 




MDV 


A.TMP 3 




RLC 


A 




MDV 
RET 


TMP 3,A 




END 
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